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Abstract 

Freely moving systems in space conserve linear and an- 
gular momentum. As moving systems collide, the veloci- 
ties get altered due to transfer of momentum. The devel- 
opment of strategies for assembly in a free-floating work 
environment requires a good understanding of primi- 
tives such as self motion of the robot, propulsion of the 
robot due to onboard thrusters, docking of the robot, 
retrieval of an object from a collection of objects, and 
release of an object in an object pool. The analytics 
of such assemblies involve not only kinematics and rigid 
body dynamics but also collision and impact dynamics” 
of multibody systems. In an effort to understand such^ 
assemblies in zero gravity space environment, we are 
currently developing at Ohio University a free-floating 
assembly facility with a dual-arm planar robot equipped 
with thrusters, a free-floating material table, and a free-: 
floating assembly table. The objective is to pick up 
workpieces from the material table and combine into, 
prespecified assemblies. This paper presents analytical 
models of assembly primitives and strategies for over- _ 
all assembly. A computer simulation of an assembly is 
developed using the analytical models. The experiment 
facility will be used to verify the theoretical predictions. 

1 Introduction 


The objective of this experiment testbed is to ver- 
ify the analytics of assemblies in free-floating work 
environment. This paper is organized in the follow- 
ing way: An outline of the free-floating robot fa- 
cility of Ohio University, its analytical descriptions, 
and kinematics are presented in Section 2. The an- 
alytical models of the assembly primitives such as 
self motion, propulsion, docking, pickup, and release 
are described in Section 3. An assembly problem 
is discussed in Section 4. An outline of a general 
purpose simulation program FLOAT is described in 
Section 5 which is designed to study strategies of 
assembly. 

2 Free-Floating Facility 
2.1 Physical Setup 

The free-floating robot facility of Ohio University 
consists of a free-floating dual-arm planar robot, a 
free-floating material table, and a free-floating as- 
sembly table. A photograph of the dual-arm free- 
floating robot is shown in Figure 1. Each of these 
three units rests on a granite surface supported by 
four air bearings. Regulated supply of Nitrogen 
from pressurized cylinders float the units on the 
granite surface. The robot consists of two arms, 
each with 3 revolute joints and a prismatic joint. 


Over the last two decades, a number of studies have 
been reported on motion planning of free-floating 
robots ([10], [7], [12], [13], [9], [11], [1], [2], [3], [4]). 
However, none of these studies dealt with analyt- 
ics of entire assemblies in a free-floating work en- 
vironment using free-floating robots. The analytics 
of these assemblies involve not only kinematics and 
rigid body dynamics but also collision and impact 
dynamics of multibody systems. In an effort to un- 
derstand assemblies in zero gravity space environ- 
ment, we are currently developing at Ohio Univer- 
sity a free-floating assembly facility with a dual-arm 
planar robot equipped with thrusters, a free-floating 
material table, and a free-floating assembly table. 


The 3 revolute joints provide the end-effector full 
mobility in the plane. The prismatic joints are used 
to move the arms normal to the table. The 8 joints 
are driven by dc servomotors fitted with optical en- 
coders. A PC 386 motherboard with power from 
rechargable lead-acid batteries sits on the base of 
the robot. The motherboard is connected to an 8- 
axis motion control board and a DAS board. Two 
quad-thrusters are mounted on the base which are 
controlled by solenoid valves that use air supply 
from the tank [5]. The robot communicates with a 
host PC 486 workstation through a radio-wave mo- 
dem. Two light bulbs fixed on the base of the robot 
are tracked by an overhead optoelectronic sensor 
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Figure 1: A photograph of a free-floating dual-arm 
planar robot built at Ohio University. 



Figure 2: An analytical model of a dual-arm 

free-floating planar robot. 


consisting of a Position Sensitive Detector (PSD) 
fixed at the focal plane of a TV lens [6]. The PSD 
sensor is connected to a host PC 486 computer and 
the voltage outputs of the sensor are calibrated to 
the position of light bulbs on the table. The sensor 
provides a feedback of base position and orientation. 

The material table also has a pressurized Nitro- 
gen tank which provides the gas needed to float the 
table on the granite surface. The material table has 
two light bulbs which are used to feedback the po- 
sition and orientation of the table to the host PC 
486 computer. This table has polished grooves to 
place the work pieces for assembly. The assembly 
table has a setup for floatation and position feed- 
back similar to the material table. The grooves in 
the assembly table are designed to store subassem- 
blies and final assemblies. 

One of the assumptions made in this paper is 
that the joints of the robot are locked during propul- 
sion, docking, pickup, and release and are unlocked 
during self motion. 

2.2 Analytical Modeling 

From an analytical standpoint, the free-floating fa- 
cility consists of the following three systems: (i) 
the robot system (RS), (ii) the material table sys- 
tem (MS), and (iii) the assembly table system (AS). 
These three systems are made up from the follow- 
ing units: (i) the dual-arm robot, (ii) the material 
table, (iii) the assembly table, and (iv) the individ- 
ual work pieces (PV,). The definitions of these three 


systems change as the assembly progresses and the 
workpieces are passed from one system to the other. 

2.2.1 Robot System 

The robot system (RS) consists of the robot and 
workpieces held by the end-effectors. The robot 
consists of seven links and its two arms are labeled 
as A and B. The base is labeled as 0, the three links 
of arm A are 1A, 2A, and 3A, and the three links 
of arm B are IB, 2B, and 3B. The gripper points 
on the end-effectors of A and B are respectively P 
and Q. These grippers are designed to catch the 
workpieces so that they extend outwards from the 
end-effector links. The joint angles of arm A are 8 ^ , 
@2 j 8§ and of B are 8f , 9% , and Of . The prismatic 
joints in the two arms are not modeled because they 
are used only periodically to lower and lift the end- 
effectors. A coordinate frame T is fixed inertially 
to the granite table parallel to the edges. A coordi- 
nate frame T R $ I s fixed at the center of mass of the 
robot system Crs * with axes parallel to the axes 
of T . 7~ o,rs is fixed on the base link at the mid- 
point of the two joints located on it. The origin of 
Trs is described relative to T by the coordinate 
variables x R $ and y RS . The coordinates x 0)RS and 
yo >R s describe the origin of To relative to Trs - #o is 
the relative orientation between the X axes of To tR s 
and T . Each link has a mass m j , a center of mass 
C/„, and a moment of inertia ij for f = 1,2,3 and 
j — A } B . These quantities for the base link are 
respectively m 0 , Co*, and 7 0 . The robot system is 
shown in Figure 2. During assembly, the inertial 
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parameters of the links 3A and 3B are computed 
from the current definition of the robot system. 

In summary, the robot system is described by 11 
variables: x RS , Vrs, ,/*s> yo } RS, &o, , ^2 » ^3> 

, and During self motion, the 6 joint an- 
gles of the robot are actively controlled and during 
propulsion, docking, and pickup, these 6 joints are 
locked. 


2.2.2 Material Table System 

The material table system (MS) has 8 slots for the 
workpieces W\ , . . . , W$ to rest. The center of mass of 
the current system is labeled as Cms* • A coordinate 
frame Tms is fixed to MS at Cm s* parallel to the 
edges of the material table. The origin of Tms is 
described relative to T by the variables xms and 
Vms> 9ms is the relative angle between the X axes 
of the frames T and Tms • A sketch of the material 
table system is shown in Figure 3. 


2.2.3 Assembly Table System 

The assembly table has slots to store the intermedi- 
ate and final assemblies. The center of mass of AS 
is at Cas+- A coordinate frame T as is fixed at the 
center of mass Cas * with axes parallel to the edges 
of the assembly table. Tas is described relative to 
T by 3 coordinate variables xas, Vas > and Qas- 
A sketch of the assembly table system is shown in 
Figure 4. 


Kinematics 

2.3.1 Robot System during Free Motion 

With the assumption that the center of mass of 
RS is at Crs+ , the 11 variables must satisfy 2 con- 
straints: 

m 0 r 0 . + mf r£ + + mf rf, + mf rf, 

+mf rf, = ttirsTrs* (!) 

where the position vectors are to the center of mass 
of the respective links in T . On time differentiating 
the above equation and collecting the terms, it can 
be written in the following form: 

ail^0,/i5 + 013^0 + + 015^2* + a 16^3 + a 17$? 

+ 018 $^ + <* 19 ^ 3 * = 0 ( 2 ) 

0222/0, KS + 023^0 + 024^1* + 025^2* + a 26^3 + a 270? 

+ 02 S&2 + a 29^ — 0 (3) 

where the coefficients a,j are functions of geometry 
and inertial parameters of RS. 

During free motion, the applied joint actuator 
torques are internal. As a result, the linear mo- 
mentum of RS in the plane and angular momentum 
normal to the plane remain constant. These three 
equations can be written as: 

™rs*rs - K\ ( 4 ) 

mRsVRs — Ki (fi) 

033^0 + 034 ^ 1 * + 035^ + 036^ + a 37@]* + 038^ 

+039^f = I<3 (6) 

where turs is the mass of the robot system and K\, 

I<2> K 3 are constant values of momentum compo- 
nents during free motion. These equations do not 
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hold when the robot is acted on by external forces 
during propulsion, docking, and collision. 

2.3.2 Robot System with Locked Joints 

With the six joints locked, RS becomes a single rigid 
body. Hence, zo,j* 5 , yo,RS become dependent on 
X RS> Vrs » and # 0 * Hence, it is more convenient to 
describe the robot system by 3 independent vari- 
ables: x/? 5 , VRS) and 9q. In order to facilitate 
the developments of this paper, we define a vector 
Xrs = (xrs ,URS > @o) T • Unless acted on by exter- 
nal forces or impacts, Xrs remains constant. 

2.4 Table systems 

We define the vector X M s - {xms, J/ms, Qms) t 
to describe the motion of the material system and 
X ,45 = (xaSiVas, &as) T to describe the motion of 
the assembly table system. The rates remain 
constant during motion unless MS is acted on by 
external forces or there is collision. Similarly, X^s 
remain constant during motion when the assembly 
table is not acted on by external forces. 

3 Models of Assembly Primi- 
tives 

In this paper, we will address the following assem- 
bly primitives: (i) Self motion of the robot system, 
(ii) Propulsion of the robot system, (iii) Docking of 
the robot system, (iv) Pickup of a workpiece by the 
robot system, and (v) Release of a workpiece by the 
robot system. As mentioned earlier, the joints of the 
robot are locked during propulsion, docking, pickup, 
and release and are actively coordinated during self 
motion. 

3.1 Self Motion of the Robot System 

During self motion of the robot, with prescribed mo- 
tion of the six joint angles, the time histories of 
base coordinates xq ?j rs and yo f RS are computed us- 
ing Eqs. (2), (3). The position of the center of mass 
is governed by (4) and (5) and the orientation angle 
&o is computed using (6). The center of mass of RS 
drifts with a constant velocity during self motion. 

3.2 Propulsion of the Robot System 

The robot is propelled by 2 air thrusters placed at 
T\ and T 2 on the base of the robot. The rates of RS 
during propulsion satisfy the following relation: 

M rs Xrs = Jv^fFpr) + Jv(T 2 ) t F(T 2 ) (7) 



Figure 5: A block diagram of the rate relations for 
the dock primitive. 


where Mrs is the inertia matrix of the robot sys- 
tem with respect to Xrs, Jv(T\) and Jv(l 2 ) are 
respectively the velocity Jacobians for the thruster 
locations Ti and T 2 with respect to Xrs ■ F(7\) and 
F(T 2 ) are (2x1) thrust vectors described in T . 

Given Xrs , Xrs at initial and final positions, 
time histories of the thruster forces F(7\) and F(T 2 ) 
can be selected in a number of ways to satisfy the 
conditions at the two end points. A relatively sim- 
ple way to achieve this is by selecting cubic tra- 
jectories for Xrs components that satisfy the end 
conditions. Xrs computed from these cubic tra- 
jectories can then be used to determine the thrust 
vectors as functions of time. 

3.3 Docking of the Robot System 

Assume that RS docks with MS such that after 
docking a point P of RS acquires the same veloc- 
ity as P 1 of MS and the two systems after docking 
acquire the same angular velocity. The analytical 
model of this primitive is based on collision theory 
between two rigid bodies [8]. The equations of im- 
pact for RS can be written as: 

MRs(XR S \t+ - X^slt-) = -Jp j Y d dt (8) 

where Jp is the Jacobian matrix of P on RS, and F d 
is the collision vector {F dx , Fdy > M dz ) T expressed in 
T . t+ and t— are respectively the time instances 
after and before collision. A similar equation for 
MS is: 

M M s(X MS \ t+ - X M5 |*-) = J'p J* + F d dt (9) 

where Mms is the inertia matrix of MS for Xms 
and Jpt is the Jacobian matrix of point P f on MS. 
After impact, Xrs and Xms are related as follows: 

JpX/*5|*+ = J p> Xms !*+ (10) 

On simultaneously solving these three equations, we 
obtain: 

Xa/s|«+ = [Mms + Jp fT Jp~ T M RS Jp~ l Jp>]~ 1 
[Mms^msU- + Jp ,T Jp~ T M RS XRs\tJ]Ll) 
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The velocity of the new center of mass is computed 
from the velocities of C R s* and Cwi* 


ZflS|*+ 


yRs\t+ — 


+ mwjZWi*\t- 
m R s\t- + 

+ mwiywi+\t-^ 

rn R s\t-+mwi 


Figure 6: A block diagram of the rate relations for The angular rate does not change as a result of 


the ‘pick’ primitive. 


Xns|t+ = Jp l Jp>X\fs\t+ 


pickup becuase the acting forces are normal to the 
plane of motion. Hence, 0/?s|<+ = Using 

the velocity Jacobian of Cwi * > the rates before and 
after pickup can be related as: 

X/ts|i+ = AipXtfsIt- + A 2 P X\fs\t- (17) 


In order to concisely write the above two equations, where Aip, A 2p are defined as: 
we define the following matrices: m , 


Aid = [Mms + Jp /T Jp T M R sJp l Jp*] 1 Mms 
A id = Wms + Jp' T Jp~ T M RS Jp l Jp f ] l Jp> T 
Jp~ T M R s 

Asd = Jp~ l Jp ' ( 13 ) 

The rates of the two sytem can then be written as: 

c 

X M5 |t+ = A\d^Ms\t- T A 2 dX/2s| f _ c 
Xhs|<+ = A3dXjv/s|*+ (14) , 

A block diagram of the docking primitive is shown * 
in Fig. 5. It must be noted that M R s and Mms 
depend on the definitions of the two systems at 
Jpi also depends on location of P* on MS, and Jp 
depends on joint angles of RS. 


Ain — 


A 2p = 


m RS\t- 

rn R s\t-+mw t 


TTifisIt- + mw t 


rnpsU-TfnWi 


1 0 y R s*wi* 

0 1 — x R s+wi*(l^) 

0 0 0 


and (xj^w.^yiis*^.*) are x and Y components 
of the vector from C R s* to Cw%* expressed in T . 

As a result of losing Wi, MS has a new position 
and velocity of the center of mass. The new center 
of mass is computed from the positions of Cms* and 
Cwi ** 


*MS|*+ = 


m M s\t-XMs\t- ~ mw%xwi*\t- 


Jpt also aepenas on location oi r on ivio, ana jp ' ' rriMs\t - — m Wi 

depends on joint angles of RS. m M s\t-yMs\t- + 

yA*sl«+ = — — f — — — t 19 ) 

rn M s\t- - m Wi 

3.4 Object Pickup by the Robot Sys- gi m il a rly, velocity of new Cms* Is computed from 


the velocities of the old Cms* and Wi. 

Once RS has docked with MS and is ready to pickup . _ mMs\t- x Ms\t- — mwi x wi*\t- 

Wi , this primitive relates the rates of RS and MS x MS\t+ — rriMs\t- — m\Vi 

before and after pickup. It is assumed that during ( m MS |,-yMs| t - - m W iywi.\t^ nn , 

pickup the applied forces are normal to the plane of yMS\t+ — tumsU — — m^y 

motion. The changes in the rates, therefore, occur 

due to redefinition of the two systems RS and MS. The two rate relations can be restructured in a ma- 
in the new definition, Wi is added to RS and Wi trix form: 

has been taken away from MS. ■ _ * . 

As a result of adding W- to RS, it has a new *MS\t+ - A^XjtfsIt- {*1) 

position and velocity of the center of mass. The w jj ere \ s defined as: 
position of the new center of mass of RS is computed 


yMs\t+ — 


from the positions of Crs* and Cwi* 

, + mwi x wi*\t- 

Xfl5, ‘ + " m RS \ t -+m wt 

, m R s It- + m Wi , 

vrs |t+ = — — , 1 

mRS\t- + m wi 


^3d — 


ki - k 2 0 k 2 y\fs»wi* 

0 ki k 2 k 2 x m s+wi* 

0 0 0 


where ki — mMsh-- rn w i ’ — ’ 

and (xjiMtWim , yRM*wi*) are X an d Y components 
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Figure 8: A block diagram of the ‘propel/dock/pick’ 
primitive. 


Figure 7: A block diagram of the rate relations for 
the ‘release’ primitive. 


of the vector from Cms* to Cwi + expressed in T . A 
block diagram of this primitive is shown in Figure 6. 
From this block diagram, we can notice that out of 
the three vectors XAfs|* 4 -> and 

any two can be chosen independently. For example, 
if XA/s|t+ and Xa/s)*- are specified X/* 5 |*_ and 
X/*s|t+ can be uniquely determined. 

3*5 Release of an Object by the 
Robot System 

This primitive relates the rates of RS and AS once 
RS releases an object W, on AS. It is assumed that 
during release the applied forces are normal to the 
plane of motion. The changes in the rates, therefore, 
occur only due to redefinition of the systems. 

As a result of removing W{ from RS, it has a 
new position and velocity of the center of mass. The 
position of the new center of mass of RS is computed 
from the positions of Crs+ and Cwi*- 


z/*s|f+ = — — r 


" * YY * ~ YV 


* I * 


rnRs\t- - mwi 

, ’n/zslt-itasrlt- — ™>wiywi\t- 

yRs\t+ = ; \ 

rriRs — mwi 


Similarly, the velocity of the new center of mass is: 


z/*s|t+ = 
2/fis|<+ = 


~ rnwi&Wi\t- 

m Rs\t- ~~ m Wi 

mRs\t-yiis\t- - mwiVwilt- 

m RS \ t --mwi 


The two rate relations can be restructured in a ma- 
trix form: 

X/*s|f+ = Ai r X/*5|(_ (25) 

where A\ r is defined as: 


A$ p - 


k 3 — k 4 0 -kiyns+wi* 

0 k 3 — k$ k^XRs+wi* 

0 0 0 


(26) 


where ifcq — li. and 

wnere rn R sU--mw t ’ * 4 m RS \ti-m Wi » ana 

( x RS*Wi*} VRS*Wi*) are X and Y components of the 
vector from Crs* to Cwi * expressed in T . 

The velocity of the new center of mass of AS is 
computed from the velocities of Cas* and Cwi+> 


^As|(+ — 


m A s\t- + mwx 


• ™, A s\t-yMs\t- + 

yAs\t+ = — — r— — ( 27 ) 

r^as !<— + 771 w i 

Similarly, the new velocity of the center of mass is: 


X AS |t+ = 

yAs|/+ = 


™As\t- x As\t- + mwi x Wi\t- 

m AS \t- + mwi 
M A s\t-ijAs\t- + mw%ywi\t 
toas|*- + mwi 


(28) 


The angular rate does not change as a result 
of adding Wi, hence, B A s lt+ = 0 A s\t-' Using the 
velocity Jacobian of Cwi * , the rates before and after 
pickup can be related as: 


X, 4 s|f+ = A 2 rX>| 5 |*_ + i4 3r X/?5|(_ (29) 


where A 2r , A 3r are defined as: 


Air — 


JPAS h r , 

m A s\i-+TTiW, 


0 

0 


BAS]* t 

™ASb- + ™W, 


0 1 


A 3 r = 


m Wl 

m AS \t - 4 - m w . 


1 0 yAS+Wi* 

0 1 -xas*iv*<-(3 3) 

0 0 0 


and (x A s*Wi*,yAS*Wi*) are X and Y components of 
the vector from C A s* to Cwi* expressed in T . A 
block diagram of this primitive is shown in Figure 7. 


4 Modeling of Assembly 

4.1 A Simple Assembly 

Consider a simple assembly task that requires the 
robot to pick W\ and W 2 from MS, assemble these 
in the form of an ‘L’ shape, and place this compos- 
ite body on AS. A possible sequence of primitives 
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Figure 9: A block diagram of the simple assembly 
described in Section 4. 


to complete this assembly task is: (i) RS propels to 
W\ f (ii) RS docks with MS to grip W\ by arm A, 
(iii) RS picks W\ from MS, (iv) RS propels to W 2 , 
(v) RS docks with MS to grip W 2 by arm B, (vi) 
RS picks W 2 from MS, (vii) RS executes self mo- 
tion to assemble W\ and W 2 , (viii) RS propels to 
AS, (ix) RS docks with AS to release Wi/W 2 , (x) 
RS releases W\/W 2 on AS. In this small assembly 
task, we saw the sequence of primitives propel, dock, 
and pickup (PDK) repeated twice and the sequence 
propel, dock, and release (PDR) once. These two 
sequences of primitives appear quite commonly dur- 
ing assembly and require further study to determine 
their characteristics. 

4.2 Propulsion/dock/pickup (PDK) 
Sequence 


Read 



Figure 10: A flowchart of execution of the three 
commands, P, DK, S using ‘FLOAT*. 


and AS while executing a specific primitive. Us- 
ing the assembly strategy, the program computes 
the motion plans for RS, MS and AS and updates 
the coordinate and rate variables of the units. A 
flowchart for the program for a sequence of three 
commands P, DK, and S is shown in Fig. 10. 


Fig. 8 shows a block diagram of this sequence of 
primitives. It can be infered from this block di- 
agram that if Xms at nodes 1 and 4 are speci- 
fied, X */5 at nodes 2, 3 and Xrs at nodes 2, 3, 

4 are uniquely determined. Also, with the propul- 
sion primitive, for any given Xrs and Xrs at node 
1, a desired X/* 5 , Xks at node 2 can be reached 
by suitably selecting a time history of the thruster 
forces. From these two observations, one can form 
a broader conclusion that it is possible to achieve 
any desired Xjv/s at the end of a PDK sequence for 
arbitrary Xms and Xrs at the beginning of the 
sequence. A similar conclusion can be made for 
propulsion/dock/release (PDR) sequence. These 
two conclusions play important roles in developing 
strategies for assembly. 

5 Description of FLOAT 

A general purpose program FLOAT was developed 
to study and test a variety of assembly strategies 
in a free-floating planar work environment. The in- 
puts to this program consist of (i) the inertial de- 
scription of the units, (ii) the geometric description 
of the units, (iii) the assembly sequence in the form 
of P/D/K/R/S/PDK/PDR commands and strat- 
egy of assembly in terms of desired values of X/?s, 
Xji/s , Xas at different points of the assembly se- 
quence. The program creates the current RS, MS, 


6 Conclusions 

In this paper, we presented a method for analytical 
modeling of assembly using a free-floating planar 
robot in a free-floating planar work environment. 
The model of the assembly was obtained by com- 
bining analytical models of five primitives: (i) self 
motion of the robot, (ii) propulsion of the robot, 
(iii) docking of the robot, (iv) pickup by the robot, 
and (v) release by the robot. It was concluded that 
assemblies typically consist of a number of propul- 
sion, dock, pickup/release sequences interluded by 
self motion. On examining a PDK sequence, it was 
observed that starting out from arbitrary velocities 
of the robot system and material system, it was pos- 
sible to achieve any desired material system veloci- 
ties by suitably controlling the thruster forces of the 
robot system during propulsion. A similar conclu- 
sion could be arrived at for a PDR sequence. These 
observations provide guidelines to select proper ve- 
locities of RS, MS, AS at intermediate steps during 
assembly. A general purpose program was devel- 
oped to study and test assembly strategies for a 
variety of assemblies. Even though this paper deals 
specifically for planar free-floating robots, the con- 
cepts can be extended to free-floating spatial robots 
working in zero gravity environment. 
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8,1 Jacobian for Points on a Rigid . . 
Body 1 

Consider a rigid body B undergoing planar motion. 

The position of a point B* on this body is described 
in an inertial frame T by the coordinates tq+ and 
ys * . The orientation of a line B * B \ is described 
by the angle 9b- The velocity Jacobian for point B\ 
with respect to i#*, ys*, 9 q in T is given as: 


■ v Blx - 


' 1 

0 

yB + B 1 


zb* 


V B ly 

— 

0 

1 

— XB*B\ 


Vb * 

(31) 

0b 


0 

0 

1 


9b m 



where ( XB*B\Q> n dyB+B\) T are X and Y components 
of the vector Tb+bi expressed in T . The (3 x 3) 
matrix is the Jacobian map for point B i labeled 
as J . The upper (2 x 3) block is the velocity 
Jacobian JY(B1). 


[ 6 ] 


m 


8.2 Inertia Matrix for a Rigid Body 


In Section 8.1, if B * is the center of mass of B, the 
inertia matrix of body B relative to the coordinates 
{x B *,yB*>0 B ) T is given as: [8] 


Mb 


tjib 0 0 

0 tub 0 

0 0 I B 



where is the mass of the body B and Is is the 
centroidal moment of inertia about an axis normal 
to the plane of motion. 
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